#include "niming.h"
//#include "usart.h"

uint8_t datetosend[100];
void niming_sendF1(int16_t pitch,int16_t roll,int16_t yaw)
{
	char cnt=0;
	datetosend[cnt++]=0xAA;
	datetosend[cnt++]=0xFF;
	datetosend[cnt++]=0xF1;
	datetosend[cnt++]=6;
	
	datetosend[cnt++]=pitch;
	datetosend[cnt++]=pitch>>8;


	datetosend[cnt++]=roll;
	datetosend[cnt++]=roll>>8;
	

	datetosend[cnt++]=yaw;
	datetosend[cnt++]=yaw>>8;
	
	
	char sc=0;
	char ac=0;
	for(char i=0;i<datetosend[3]+4;i++)
	{
		sc+=datetosend[i];
		ac+=sc;
	}
	
	datetosend[cnt++]=sc;
	datetosend[cnt++]=ac;
	
//	HAL_UART_Transmit(&huart1,datetosend,cnt,100);
	
}
